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i. INTRODUCTION 


A. MOTIVATION 


Reliable robot vehicles, capable of safely performing complex actions without the 
need to place a human in harm’s way, have become a top priority in today’s world. To 
realize the greatest benefit, these robot vehicles must be able to operate autonomously in 
a rational manner in performance of their tasks. Autonomous vehicles are generally 
defined as vehicles that are capable of reasonably “intelligent” motion and action without 


requiring either a guide to follow or an operator to control them in real time [1]. 


Of particular interest to our naval forces is the deployment of such devices to 
reduce or eliminate the catastrophic effect that mine warfare has in today’s littoral 
warfare. The following quote taken from the Naval Mine Warfare Vision 2010 


emphasizes this point: 


Naval Mine Warfare comprises a critical part of our future 
warfighting capability. The proliferation of mines throughout the world as 
cheap means of sea control and the downsizing of our Naval forces dictate 
that mine countermeasures . . . become an integral part of our National 
Military Strategy. Naval Mine Warfare will perform an enabling role for 
Joint and Coalition forces [2]. 


That same document goes on to state that United States Naval forces must possess 
Autonomous Underwater Vehicles (AUVs) to facilitate rapid and thorough clearance of 


any mined sea lanes [2]. 


One of the greatest challenges to the successful development of truly autonomous 


mine hunting vehicles is the ability to link logically based high-level mission planning 
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software with low-level vehicle control software. Control software for these systems 
exists at the highly abstract “logical” level and at the extremely low “hardware 
operations” level [3]. The implementation of these two levels results in specific top-to- 
bottom software interaction that are hard-coded for a particular application and task. A 
change in implementation, and even the simple addition of a new capability, results in a 
need to re-work the code at both ends. This code rework invites the introduction of new 


errors into the code as well as increasing the overall code complexity. 


What is required is an intermediate level, a generic framework that can be both 
mission and platform independent. This intermediate level would provide standard 
Application Programming Interfaces (API’s) for low level components while having the 
ability to accept a wide range of high-level mission commands and tasking. An API is the 
software that 1s used to support system-level integration of software products or newly 
developed software into existing or new applications. APIs provide for interoperability 
across different platforms; this is an important feature when developing new or upgrading 


existing [distributed] systems [4]. 


An approach to implement this intermediate level is to utilize a Rational Behavior 
Model (RBM), developed in detail by Byrnes [5] and implemented by Kwak [6], Holden 
[3], and Leonhardt [7] for the Naval Postgraduate School (NPS) Phoenix AUV. The 
RBM is a three-level software architecture consisting of Strategic, Tactical and Execution 
levels with respective emphasis on mission planning, programmed vehicle responses 
labeled "behaviors," and efficient real-time execution of vehicle hardware control 


programming. The RBM is described in Chapter II. 


B. APPROACH 


This work builds on those completed by Kwak, Holden and Leonhardt by 
continuing to enhance the design of a Tactical level control software package for an 
autonomous robotic vehicle. This enhancement of the Tactical level is accomplished by 
incorporating object oriented software design and implementing it using concurrent 
tasking techniques and the multilanguage interfacing capabilities available using the Ada 
95 programming language [8]. The design was demonstrated on a single processor 
Personal Computer highlighting the benefits of concurrent tasking and the advantages of 
multiple processes “sharing” a single Central Processing Unit (CPU). These design 
enhancements move the promise of rationally-behaving autonomous vehicles further 
toward the goal of rapidly deployable vehicle control software, without a labor intensive 


programming effort for each mission. 


C. SCOPE 


A representative Tactical level software package for an Autonomous Underwater 
Vehicle was developed using the Ada 95 programming language. Use of Ada 95 enabled 
the design to incorporate multiple tasks (processes) and a multilanguage interface to the 
execution level software. The Execution level software used for this work was taken from 
the A.R.LE.S. AUV developed by the Center for AUV Research at the Naval 


Postgraduate School [9]. The A.R.IE.S. 1s described in Chapter II. 


Within the Tactical level software individual Ada tasks were used to modularize 
code into separate concurrently operating processes synonyms with the delegation of 
responsibility performed by a human submarine crew [3]. For the scope of this thesis the 
main controlling process is referred to as the Officer of the Deck (OOD). The OOD 
process and its related function packages will perform the mission planing and coordinate 
the efforts of the entire vehicle. Navigator, Engineer, and Deck Log processes were 
incorporated to perform the individual tasks of vehicle navigation, propeller motor and 


control surface actuation, and event recorder respectively. 


This thesis will demonstrate the validity of the design by providing the Tactical 
level software package with a simple high-level execute order statement. That order will 
then be used to initiate the required actions to perform the mission. The interface package 
will enable the Tactical level to make calls to the Execution level code to drive the 
propeller motors and to position the control surfaces of the autonomous vehicle. This 
software package demonstrates asynchronous control transfer between tasks running 
concurrently, interaction (communication) between tasks, and function calls to existing 
Execution level software. This provides the framework for full implementation on an 


actual vehicle. 


D. THESIS ORGANIZATION 
Chapter I: Introduction. This chapter gives a general outline of the work, 
including motivation, approach, scope of the work, and the thesis organization. 


Chapter II: Background. This chapter contains pertinent background information 


on Unmanned Underwater Vehicle (UUV) programs, the Rational Behavior Model 
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(RBM), Software Engineering, Concurrent Programming, and the NPS A.R.LE.S. 


Underwater Autonomous Vehicle. 


Chapter III: Software Architecture. This chapter describes the Tactical level 


software architecture and the interface to the Execution level. 


Chapter IV: Implementation. This chapter describes the implementation and 
execution of the code. It provides necessary information and program code to conduct the 


experiment. 


Chapter V: Conclusions and Recommendations. Includes theoretical 


improvements and future work. 
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Hi. BACKGROUND 


A. US NAVY UNMANNED UNDERWATER VEHICLE PROGRAM 


To meet the requirement for developing Autonomous Underwater Vehicles 
(AUVs) for mine reconnaissance the Director of the Navy’s Expeditionary Warfare 
Division (N85) has been given the responsibility for establishing the Navy’s Unmanned 
Underwater Vehicle (UUV) Program. The Navy’s first priority in its UUV plan is rapid 
development of a covert mine reconnaissance capability [11]. A two tiered approach was 
implemented to develop the systems needed to provide both near term and long term 


systems to meet the requirements set forth in the UUV Program Plan [10]. 


The first was understandably labeled the Near Term Mine Reconnaissance System 
(NMRS) program. This program capitalizes on existing technologies for rapid 
deployment of a mine reconnaissance system. The NMRS will utilize a vehicle controlled 
via fiber-optic cable connected to the launch platform [12]. This approach highlighted the 
fact that true autonomy was not yet achievable for the deployment of the NMRS. The 
second program labeled the Long Term Mine Reconnaissance System (LMRS), was 
directed to develop the system that would eventually replace the NMRS. This program 
concentrated on investigating emerging technologies and developing new ones that would 
provide significantly tmproved capability over the NMRS, namely autonomous 
operations endurance of more than 40 hours [11]. This thesis seeks to further the 
development of truly autonomous vehicles by providing a framework for a robust 
software architecture capable of controlling an Autonomous Underwater Vehicle (AUV). 
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B. | RATIONAL BEHAVIOR MODEL (RBM) 


The Rational Behavior Model (RBM) develops an approach to linking high level 
logical mission planning for autonomous vehicles with low-level vehicle control 
programming. The result is a three-level software architecture consisting of the Strategic, 
Tactical and Execution levels, each to be implemented in a way perfected or better suited 
for use at that level. The Strategic level 1s programmed with emphasis on mission 
planning, the Tactical level is programmed for vehicle responses ("behaviors"), and the 
Execution level uses efficient real-time execution of vehicle hardware control 
programming [3]. Figure 1 illustrates the relationships between the three levels of the 


RBM. 


Strategic Level 


Strategic Level High-level mission planning 


Tactical Level 
Asynchronous coordination between the Strategic 
Level and the Execution. 


Tactical Level 


Execution Level 

Responsible for hardware control. Ensures basic 
vehicle stability, maintaining navigation, propulsion, 
and similar systems. 





Figure 1. Rational Behavior Model 


Ie Strategic Level 


The Strategic level is comprised of essential mission planning software. It uses 
high-level mission logic and provides for the deterministic sequencing of the underlying 


behaviors implemented for that particular autonomous vehicle [5]. 


Dle Tactical Level 


The Tactical level includes programmed vehicle responses and implements the 
behaviors capable of satisfying the goals assigned by the Strategic level. It acts as the 
intermediary under the Strategic level direction and provides an interface for issuing the 
commands necessary to direct the performance of the Execution level. The Tactical level 
must also interact with the Strategic level either explicitly, as answers to specific queries, 
or to simply respond upon the completion of a commanded behavior [5]. 

Behaviors contained within this level are non-logic-based executed processes 
being performed by one or more entities within the Tactical level. The use of more than 
one entity will enable asynchronous control of necessary functions to enable the vehicle 


to operate in an autonomous fashion [3]. 


3. Execution Level 


The Execution level provides efficient real-time execution of vehicle hardware 
contro] programming. Responsible for all of the physical actions of the vehicle, this is the 
software intermediary between the Tactical level and the actual hardware of the vehicle, 
and must meet all the hard real-time scheduling requirements to ensure basic vehicle 


stability, maintaining navigation, propulsion, and similar systems [5]. 


C. SOFTWARE ENGINEERING 


The Software Engineering approach to developing software applications or 
systems is one of forethought rather than afterthought. Traditional engineering practices 
such as requirement documentation, analysis of design, modeling, component testing, and 
incremental inspections are common place in electrical, mechanical and civil engineering 
projects. All of these practices serve to prevent design changes during construction 
(which are often physically impossible to do), or failure of the completed project during 
its useful life span. All too often software projects are kicked off before any of these 


critical issues are considered. 


In addition to the use of the engineering design philosophies mentioned above 
during the development phase of designing software systems, the following principles are 


also considered when taking a Software Engineering approach: 


Maintainability: the ease with which a software system or component can be 


modified to correct faults, improve performance, or other attnbutes, or adapt to a change. 


Reusability: the degree to which a software module or other work product can be 


used in more than one computing program or software system. 


Flexibility: the ease with which a system or component can be modified for use in 


applications or environments other than those for which it was specifically designed. 


Scalability: the ease with which a system or component can be modified to fit the 


problem area [13]. 
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The software package for control of an autonomous vehicle described in this 
thesis was developed with these Software Engineering principles in mind. It incorporates 
object oriented software design for modeling the application domain. The model used is 
based on human operators in a manned submarine for modularity. It is implemented using 
concurrent tasking techniques for performance, flexibility, and scalability, and it uses 


multilanguage interfacing capabilities to take advantage of code reuse. 


D. CONCURRENT PROGRAMMING 


Traditional programming techniques involve a sequence of actions performed one 
after another. Concurrent programming entails two or more traditional sequences of 
actions to be performed concurrently within the same program. Concurrent programming 
enables asynchronous control transfer, meaning a process can initiate the task to perform 
some other action and then can continue its own sequence while the other process (task) 


is busy fulfilling the request [14]. 


i Single processors 


The multitask program that 1s running on a single central processor unit (CPU) 
computer will share that computer’s CPU between tasks. This is called interleaved 
concurrency. The benefit to multitask programs running on a single CPU computer are 
realized when a wait, on some external event such as the completion of an input 
operation, or delay occurs in a task that is accessing the CPU. While a task is delayed the 
other task(s) can access the CPU. Very short, 1/100 sec, delays can be preprogrammed 


into the sequence of tasks to force time sharing of the CPU by the various tasks. 


Hal 


2 Multiple processors 


If the multitask program is compiled to run on a multiple processor computer then 
different processors will actually execute different tasks at the same time. This is called 
overlapped concurrency. The compiler handles the scheduling of multitasked programs, 
enabling the same program that is implemented on a single CPU computer to be re- 


compiled for use on a multiple CPU machine. 


Concurrent programming techniques are used for many different reasons. 
Programs designed to monitor or control several devices are most easily written with one 
task managing each individual activity. The use of tasks can allow programs to finish 
more quickly by sharing the CPU or through the use of multple CPU’s. Simulation 
programming can benefit by using tasks designed to run within the rules of each entity 


modeled for the simulation [14]. 


E. NPS A.R.LE.S AUV 


The Center for Autonomous Underwater Vehicle (AUV) Research at the Naval 
Postgraduate School (NPS) designed and built the Acoustic Radio Interoperative 
Exploratory Server (A.R.ILE.S.) AUV for research and development of AUV systems. 
The A.R.LE.S. is the replacement vehicle for the NPS Phoenix AUV described in the 
work done by Kwak [6], Holden [3], and Leonhardt [7]. The Phoenix has been 
decommissioned and now sits as a display in the NPS research museum. The A.R.LE.S. 


is Shown in figure 2. 
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Figure 2. NPS A.R.LE.S. Autonomous Underwater Vehicle 


The term “Server,” used in the acronym describing the latest NPS AUV comes 
from research in the use of multi-vehicle fleets of AUVs linked to a supervisor vehicle, or 
server, for minesweeping operations [15]. The A.R.I.E.S. design incorporates an acoustic 
modem to facilitate data links between AUVs while under water. The A.R.LE.S. uses 
dual computer architecture with each computer dedicated to perform specific vehicle 
software and hardware functions. It uses a modular multi-rate, multi-process 
configuration for semi-autonomous and autonomous underwater vehicle operation. The 
two computers communicate over standard TCP/IP network sockets. Other computers 
can be logged into the vehicles network either by cable or wireless connection. The dual 
computer implementation uses one system for data gathering and running navigation 


filters, while the second computer uses the output from the first computer to operate the 
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various auto-pilots for servo level control. The A.R.LE.S. performs its mission in 
accordance with a sequential mission script file that 1s preloaded onto the vehicle, or can 


be downloaded/modified via an external computer logged into the vehicle's network [9]. 


The only relation between A.R.ILE.S. and this thesis was the partial use of 
A.R.LE.S. execution level software code that drives the propeller motors and positions 


the control surfaces of the vehicle in response to the auto-pilots direction. 


The file named Execf.c, for execution functions, was written in C programming 
language by Dr. Dave Marco, Dept. of Mechanical Engineering, Naval Postgraduate 
School, Monterey California. Only the functions related to driving the propeller motors 
and positioning the control surfaces were adopted from Dr. Marco’s original code. Other 
lines of code within the borrowed functions that were not pertinent to this work were 
deleted. The shell of the actual code used onboard an operating AUV was used to 
highlight the capability of the design. The functions that were selected to interact with the 
Tactical level code were used to simulate control of the following hardware components 
onboard the A.R.LE.S. AUV: left propeller, right propeller, left bow plane, mght bow 
plane, left stern plane, nght stern plane bow rudder, and a stern rudder. The A.R.I.E.S. 
AUV also incorporates bow and stern lateral thrusters and bow and stem vertical 


thrusters [9]. The control of these last four components was not addressed in this thesis. 
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HI. SOFTWARE ARCHITECTURE 


A. INTRODUCTION 


This chapter describes the Software Architecture applied to the design of the 
representative tactical level software package for an Autonomous Underwater Vehicle. 
The architecture was designed for the Ada 95 programming language and includes the 
components required for the interface to the Execution level software. Figure 3 illustrates 


how the Tactical level architecture fits within the framework of the RBM. 


Software Architecture 
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Figure 3. Autonomous Vehicle Software Architecture 
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B. APPROACH 


This work’s ultimate goal was to provide a robust software architecture capable of 
performing the intense data management required for a robot vehicle to operate 
autonomously in the performance of its mission. To accomplish this, Ada tasks were used 
to provide concurrency among functions modeled after human submarine operators. This 
approach also served to modularize functions in a logical manner. Figure 4 illustrates the 


major components within the Tactical level software architecture. 
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1. Tactical Level Application Components 


The main controlling process for the Tactical level is referred to as the Officer of 
the Deck (OOD) analogous to the human watch stander in charge of all operations aboard 
a naval vessel. The OOD will perform the mission planing and coordinate the efforts of 
the Ada Tasks utilized within this Tactical level software architecture. Ada Tasks are 
spawned, concurrently, to perform specific actions or for continuos control of critical 
parts of the robot vehicle to maintain stable operation. The Navigator, Engineer, and 
Deck Log tasks were incorporated in this demonstration to perform the individual tasks 
of vehicle navigation, propeller motors and control surface actuation, and event recorder 
respectively. The use of Ada tasks enables the tasks’ sequential procedures to be 
performed independent of the operation of the OOD, or any other task unless specifically 
programmed rendezvous are required by the software design [14]. The major packages 
and procedures utilized for the demonstration of this software architecture are described 
below. A more detailed description is found in chapter IV, Implementation. 

The OOD Task Manager package receives the simple high-level execute order 
statement from the Strategic level via its Receive Orders procedure. That order will then 
be used to invoke the Officer Of The Deck procedure in the body of the OOD Task 
Manager package to control the rest of the required actions to perform the mission. When 
the Officer Of The Deck procedure is finished, the Tactical level is exited and control is 
retumed back to the Strategic level. The Officer Of The Deck procedure calls the Mission 
Planner procedure to carryout the orders received. The Mission Planner contains the 
sequential mini-missions, which make up the complete operation directed by the simple 


high-level execute order statement sent from the Strategic level. The mini-missions are 
MF 


accessed with the appropriate call to the Mission Control package. The Mission Control 
Package contains the detailed sequence of events for performing the mini-missions. This 
method provides for rapid modification or addition of new missions on a robotic vehicle 
by simply modifying the existing functions or adding new ones. 

The Officer Of The Deck procedure and the procedures within the Mission 
Control package all utilize the OOD package to perform their respective mission 
sequences. The OOD package modularizes the repeatable actions performed by the OOD. 
Removing these functions from the OOD Task Manager package reduces complexity and 
enhances the readability of the code. 

The Expert Systems package contains functions that would utilize specialized 
algorithms, access to database information, and input sources necessary to return the 
appropriate information/data back to the requesting Tactical level entity. They can be 
used by the Officer of the Deck procedure itself or any of the tasks as required to 
complete their function. This method supports upgrades and expandability by providing 
standard interfacing specifications at the time of design. This implementation simulates 
two expert system functions. The first is called to determine the next course to station. 


The second is called to determine a course for which to begin the mine-hunting mission. 


2. Interface to the Execution Level 


The Wrap AUV C Code package contains the wrapper functions required for the 
Tactical level to make calls to and receive calls back from the Execution level. A wrapper 
function in Ada contains the standard Ada function interfaces to interact with the rest of 


the Ada program code. For each of these functions an import or export pragma 1s used to 
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provide the required interface information for access to/by the other language function 
[14]. The use of this package enables the Tactical level to link to the vehicles Execution 
level functions which control the hardware, input/output devices, and sensors. 

The Execution level code is wmitten in a language decided on by the vehicle 
hardware developers, and is platform specific. An Ada interface can be provided for a 
variety of software languages and could support many different platforms [8]. 

In order to interface the Execution level code an object file (.0) must be included 
in the linker options when the Ada code is compiled. An object file is created when 
compiling the execution level code. The object file (.o) enables the Ada code to be linked 
to the Execution level functions during the compilation of the main Tactical level 
application. An interface package using wrapper functions as described above is then 
written in Ada to handle the code interaction between the Ada application and the other 
programming language functions. 

A concern, which is not addressed in this thesis, is the requirement to account for 
compiler, code, and operating system compatibility. There are many combinations that 
will work and many new methods and compilers are becoming available on a continuing 
basis. 

The architecture utilized for this thesis contains both import and export pragma 
functions. These functions enable two way interactions between the Ada application 
program and the execution level code wntten in C programming language and are 


described in detail in Chapter IV. 
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IV. IMPLEMENTATION 


A. STRATEGIC LEVEL IMPLEMENTATION 


The Strategic level was interfaced as a “black box” for the purpose of this thesis. 
A single Ada program with a procedure named CO_ Strategic Level was used. This 
procedure initiates the high level command that would be given by a logic based Strategic 
level program. For this demonstration the direction given to the Tactical level was simply 


what to do and where to do it. The complete code can be found in Appendix A, Section 1. 


B. TACTICAL LEVEL IMPLEMENTATION 


The Tactical level is comprised of six Ada software packages. Each Ada package 
is comprised of a specification file and a like named body file. The specification file 
contains the interface descnptions for the procedures and functions that are implemented 
in the package body. The packages used in this demonstration are described below. The 


complete code can be found in Appendix A, Section 2. 


ibe OOD Task Manager Package 


The OOQD_Task_ Manager Pkg controls and directs the actions of the AUV to 
meet the assigned mission. The Officer Of The Deck procedure within the 
OOD_Task Manager Pkg is the sequential series of statements and function calls that 
culminate in the completion of the assigned mission. The procedure begins when the 
order is sent from the Strategic level code to the Tactical level via a call to the procedure 


Receive Orders. With the call to this procedure comes the pertinent information on what 
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to do and where to do it. The Receive Orders procedure is the only connection from the 
Strategic to the Tactical level. Subsequent interaction back to a Strategic level is not 
addressed in this demonstration. 

The Mission Planner procedure, when invoked by the Officer Of The Deck 
procedure, makes the call to the appropriate procedure within the Mission_Control_Pkg. 
This enables the OOD to call various Mission Control procedures multiple times in order 
to complete a larger mission goal. 

The OOD _ Task Manager Pkg also contains several Ada Tasks to concurrently 
perform specific actions or for continuous control of critical parts of the AUV to maintain 
stable operation. The Navigator (NAV), Engineer (ENG), and Deck Log (LOG) tasks 
will immediately be spawned upon initialization of the main program. These tasks will be 
blocked at their accept entry point and become available to act as directed by the 
Officer Of The Deck procedure and also by procedues from within the 
Mission Control Pkg. The Navigator, Engineer, and Deck Log tasks were incorporated 
in this demonstration to perform the individual tasks of vehicle navigation, propeller 


motor and control surface actuation, and event recorder respectively. 


a. Ada Tasks 


Both the Navigator (NAV) and the Engineer (ENG) tasks utilize three Ada 
task accept statements as entry points. The three accept statements are Taking Action, 
Making Report, and NAV_Aye or ENG Aye. The accept statements Taking Action and 
Making Report facilitate communication among procedures and tasks. The 


NAV/ENG Aye allows for an action order to be sent to the appropriate task. 
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The Navigator (NAV) task provides for functions regarding ship's position 
and course to station. A case selection is used based on an order type sent to the accept 
statement NAV_ Aye. The order types CourseToStation and GivePosition perform the 
function as the names apply 

The Engineer (ENG) task interacts with the Execution level code to drive 
the propeller motors and position the control surfaces. A case selection is used based on 
an order type sent to the accept statement ENG Aye. The order types AllStop, AllAhead, 
PortStop, PortAhead, PortBack, StbdStop, StbdAhead, and StbdBack provide for 
propeller motor control. The order types RightRudder, LeftRudder, UpPlanes, and 
DownPlanes_ provide for positioning the control surfaces. The order type 
EmergencySurface is the abort mission call and sets the propeller motors and control 
surfaces to return the AUV to the surface of the ocean. 

The Data Logger (LOG) takes all communications that utilize the 


communicate procedure within the utilities package and logs them in a text file. 


2 OOD Function Package 


The OOD_Pkg provides for modularization of OOD actions. The procedures 
Taking Action and Roger Out facilitate communication among procedures and tasks. 
The procedure Give Order allows for an action order to be sent to the appropriate task 


using the case selection described above. 


3 Mission Control Package 


The Mission Control Pkg contains detailed sequences for performing specific 
mini-missions. The mini-missions are pieced together to complete the requirements of the 


high-level mission order statement. 


4. Expert Systems Package 


The Expert Systems Pkg contains functions that would utilize specialized 
algorithms, access to database information, and input sources necessary to return the 


appropriate information/data back to the requesting Tactical level entity. 


5. C Code interface 


The Wrap AUV_C_ Code _ Pkg provides access to Execution level functions. This 
interface package enables the Tactical level to make calls to the Execution level code 
and, in this case, simulate driving the propeller motors and positioning the control 
surfaces of the AUV. 

The key to the interface is the object file created when compiling the Execution 
level code. The Object File (.0) enables the Ada code to be linked to the Execution level 
functions during the compilation of the main Tactical level Application. 

Three procedures, Text From C Function, End Text From _C Function, and 
Double_From_C_Function utilize the pragma Export to enable the Execution level to 
communicate back to the Ada program for simulated response by the vehicle propellers 
and control surfaces. 

The remaining procedures all utilize pragma Import to give the Tactical level code 


access to the Execution level functions. They are: Stop Screw Motors, Rudder_Angle, 
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Planes Angle, Zero Fins, Abort_Mission, Left_Screw_Speed_Control, and 
Right Screw Speed_Control. They all give Execution level control access to the Tactical 


level as each procedure name applies. 


6. Utilities Package 


The Utilities Pkg provides for screen output formatting and system clock 
functions. A Communicate procedure is used to provide a way for all information 
exchanges to be logged in the vehicle deck log and to provide the screen output for use in 


code development and debugging efforts. 


CG; EXECUTION LEVEL IMPLEMENTATION 


The Execution level code used for this thesis was written in C programming 
language. The code used is based on program functions wntten by Dr. Dave Marco [19] 
for the NPS A.R.I.E.S. AUV and was modified by the author as indicated within the 


code. The complete code can be found in Appendix A, Section 3. 


The functions used for this thesis are used to drive the propeller motors and 
position the control surfaces of A.R.I.E.S. The NPS A.R.LE.S. AUV has a left and nght 
propeller motor and the following control surfaces: left bow plane, mght bow plane, left 
stern plane, nght stern plane. bow rudder, and a stern rudder. The NPS A.R.I.E.S. AUV 
also incorporates bow and stern lateral thrusters and bow and stern vertical thrusters. The 
control of these components was not included in this thesis. The interface to the propeller 


motors and the control surfaces functions are: 


StopScrew Motors( ) - sets motor control voltage to zero for both motors. 


ZS 


ScrewMotor(int Motor, double ControlVolt) - sets the indicated motor control 


voltage to the designated voltage. 


ControlSurface(int Surface, double Angle) - sets the indicated control surface to 


the desired angle. 
Rudder(double Angle) - sets the rudders to the desired angle. 


Planes(double BowAngle, double SternAngle) - sets the planes to the desired 


ZeroFins( ) - sets all control surfaces to zero angle. 


Abort( ) - sets the motor control voltage for both the left and the nght propeller to 
ahead propulsion, and sets the control surfaces to bring the vehicle to the surface of the 


water. 


LeftScrewSpeedControl(double n-com) - sets the control voltage sent to the left 


propeller motor to the desired level. 


RightScrewSpeedControl(double n-com) - sets the control voltage sent to the night 


propeller motor to the desired level. 


D. CODE TEST SCENARIO 


The text in Appendix B is from the screen output during code execution. The 
high-level order statement from the Strategic level directs the AUV to hunt for mines at a 
specific Latitude and Longitude. The first step in completing this mission is to transit to 


the indicated position. The NAV task is accessed to give a course to station. The NAV 
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task accesses the appropriate Expert System function, which will compute the course 
station. When the NAV task returns the course to station to the OOD, the OOD then gives 
the order to the ENG task to make way and gives a rudder order to come to that course. 
When on the appropriate course the order is given for rudders amidships. A full 
implementation can have the NAV task and the ENG task interact to maintain on track as 
current and sea state act on the vehicle. When on course the OOD gives the order to the 
ENG task to dive the Vehicle underwater. When at the desired depth the OOD orders 
zero planes. The OOD queries the NAV task for the current location and is informed that 
they are at the directed position to begin hunting for mines. The OOD orders the ENG 
task to come to all stop. At this point the transit operations are complete and control 
transfers to the Hunt Mines procedure. The OOD requests a course to hunt mines for the 
NAV task. The NAV task accesses the appropriate Expert System function to compute 
the course to hunt mines. When the NAV task returms the course to hunt mines, the OOD 
then gives the order to the ENG task to make way and gives a rudder order to come to 
that course. When on the appropriate course the order is given for rudders amidships. The 
report then comes saying that they have completed the Mine-Hunt operation. The OOD 


gives the ENG task the order to surface and the AUV is recovered. 


THIS PAGE INTENTIONALLY LEFT BLANK 
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V. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSION 


The Tactical level software architecture design described in this thesis has been 
implemented and was successfully demonstrated on a personal computer running under 
Windows NT 4.0 service pack 5. The success of this partial implementation of a 
concurrent Tactical level working within the proven design of the Rational Behavior 
Model provides the framework needed for full implementation and testing of the design 


on an actual robotic vehicle. 


B. IMPROVEMENTS OVER PREVIOUS DESIGNS 


This design provides the flexibility required for a robotic vehicle to perform 
multiple missions without the need to re-work the code at both ends. This 1s 
accomplished through the use of the Mission Control Package. Multiple mission profiles 
can be preprogrammed into the vehicle and accessed as required to perform a specific 


mission. 


The robustness required for a robot vehicle to handle the intense data management 
needed to operate autonomously is gained through the use of Ada tasks. These tasks 
allow for concurrent program sequences to perform specific actions independent of each 


other. 
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The design enables the use of the Tactical level program to be portable to other 
platforms. Only the Interface Package needs to be modified to facilitate a new vehicles 


Execution level code interface. 


C. RECOMMENDATIONS 


The results of this research are promising. Full development of this software 
design would improve existing AUV operational capabilities and provide a valuable 
source of research in the field of mobile robotics. Effort should be made to incorporate 
this design in building a Tactical level software module that would address all the 
required procedures and functions needed for a robotic vehicle to autonomously complete 


a mission. 


D. FUTURE WORK 


This work shows the framework of a Tactical level using Ada tasks and the 
interface to the Execution level code written in a different programming language. There 
is more work required to develop the complete design and incorporate all the necessary 
functions and procedures required for autonomous operation of a robotic vehicle. A few 


specific areas of further research needed are listed below: 


1. Full implementation using a software simulated vehicle 


Develop the complete design and incorporate all the necessary functions, 
procedures, and tasks required for autonomous operation of an AUV. This development 


should proceed using a software simulation of an actual operating AUV. This would 
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enable the Tactical level software development to occur concurrently with the 


development of the vehicle and its Execution level software. 


wa Expert systems within the Tactical Level 


The key to total robot vehicle autonomy lies in the ability to relate experienced- 
based knowledge to vehicle control software. 

Expert systems will be required to enhance the operational capability of the robot 
vehicle. Interfaces can be established even if a particular Expert System technology has 
yet to mature. When the system matures and becomes available it can easily be 


incorporated into the desired vehicle. 


SE Porting to Multiprocessor Platform 


This thesis incorporated the use of a single CPU computer. Further research into 
using multitasked control software on multiple CPU computers promises some distinct 
advantages. With the addition of multiple processors the compiler will be able to 


distribute the load evenly between tasks and enhance system performance. 


3] 
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APPENDIX A. CODE 


1. STRATEGIC LEVEL CODE 


--| FileName : CO Strategic Level.ada 

--| Author : LT William D. Carroll, USN 

--| Date : June 2000 

--| Course : N/A 

--| Project : Thesis 

--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 


--~| Description: This program provides the Tactical level with a simple 
--| order statement: what to do and where to do it. 


WITH Ada.Text_I0O; 
WITH Utilities; 
WITH OOD Task Manager_Pkg; 


PROGEBURE CO St rateque sucvemmeiae 
BEGIN 


--North latitudes, and WEST longitudes are entered as positive 
--numbers, but it is not necessary to use a "+" sign. 

--For example, 45.00° North would be entered as 45.00 

--South latitudes and EAST longitudes are entered as negative 
--numbers using a "-" sign. 

--For example, -125.00 represents 125.00° East Longitude. 


OOD_Task_Manager_Pkg.Receive_ Orders (Orders =S) Pune mines 
Latitude => 36.7, 
Longitude =s 1222 765); 


END CO Strategic Level; 
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2. TACTICAL LEVEL CODE 


jem meee ei iii i se ee 


--| FileName : OOD _Task_Manager_ Pkg.ads 

--| Author > LT William DD. Cagpeolle, USN 

--| Date : June 2000 

--| Project : Thesis 

--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 


--| Description: This Package receives the direction from the Stratigic 
--| Neve l ehrough) Glem@ecea) VemOrdens spEocedirc Ihe seouc 
--| for the NAV, ENG, & LOG tasks are located here. 


— eee eee 


PACKAGE OOD Task Manager Pkg IS 


SUBTYPE Namemcreringm type Lou cermimaqu( 1... 1O)e, 
SUBITYBEMOrdersctuing type LS tcemiung (14.1077 
SUBTYPE Repor evsering type ES eeauwing (1.720); 
SUBTYPS Moursc Strings ype loesering (12.3); 
TYPE Name Type IS (OfficerOfTheDeck, Navigator, Engineer) ; 
TYPE Order_Type IS (HuntMines, MineHuntCourse, 
CourseToStation, GivePosition, 
AllStop, AllAhead, 
PortStop, PortAhead, PortBack, 
StbdStop, StbdAhead, StbdBack, 
EmergencySurface, 
RudderAmidship, 
RightRudder, LeftRudder, 
ZeroPlanes, 
UpPlanes, DownPlanes, None); 


—_— eee iii i le 


TASK NAV IS 
ENTRY Taking Action; 


ENTRY Making Report (Name : IN Name_Type; 
RepeCGem ane pOne cee ice We). 
ENTRY NAV_Aye (Name : IN OUT Name String Type; 
Niaivi@ 9G Gruen © iscletseinyOe:, 
Latitude : Float := 0.0; 


Longitude : Float OO a, 


_——_— ei i i iii iii i 


= eee eee i i i le 


TASK ENG IS 
ENTRY Taking Action; 
ENTRY Making Report (Name : IN Name_Type) ; 
ENTRY ENG Aye (Name ;: IN OUT Name String Type; 
EngOrder : Order Type); 
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ww em eee ii 


TASK LOG IS 
ENTRY Log _It(Item mune String; 
Hour ae ee neegqen: 
Minute : IN Integer; 
Seconds: IN Float); 
ENTRY Close_Log; 
END; = —--0G 


PREGEDURE Recerve Orders (Orders ; Onder uiviae; 
Latitude : Bloat; 
Longitude : Float); 


END OOD _ Task_Manager_Pkg; 


OO ee ee ee ee ee 


--| Filename : OOD Pkg.ads 


--| Author : LT William D. Carroll, USN 
--| Date : 30 May 2000 
--| Project : Thesis 


--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 
--| Description: OOD Procedures 


WITH OOD_Task_Manager_Pkg; 


PACKAGE OOD Pkg IS 


— eee eee ei ii i 


ee a eee ey 


PROCEDURE Give_Order (Name : IN OOD Task_Manager_Pkg.Name_Type; 
Order: OOD Task Manager Pkg.Order Type; 
Latitude : Float On; 
Longitude =: Flieat :s= 0. 0pm; 


_— ii ii i iii iis i 


—_———_— ei ii wi ei i i 


—_—— iii eee 


—_—— ee em eee ii eee i i le 


PROCEDURE Roger Out(Name : IN OUT 
OOD_Task_Manager_Pkg.Name_String_Type) ; 


END OOD Pkg; 


— — ee ei wee iii i i i ie ee 


--| FileName : Mission_Control_Pkg.ads 

--| Author > LE William D. Carroll uUsN 

--| Date : June 2000 

--| Project : Thesis 

--| Compiler : Aonix ObjectAda 7-1.2.205 (Professional) 


--| Description: This package provides Mission Procedures 


CE nnn 


—_— eee eee a ie ee ee Se lL er ee le eee ele 


eee eee wee i Ce 


PROCEDURE Transit _To Location(Latitude : Float; 
Longitude : Float); 


eee ei i Ce 


PROCEDURE Hunt For Mines; 


END Mission_Control_ Pkg; 


--| FileName : Expert _Systems_Pkg.ads 

--| Author : LT William D. Carroll, USN 
--| Date : June 2000 

--| Project : Thesis 


--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 
--| Description: Expert Systems functions 


Cie elie dee eee ee ee ee ee ee ee ee ee ee ee ee ee) 


WITH OOD _Task_Manager_Pkg; 


PACKAGE Expert Systems_Pkg IS 


— mmm meee meme eee wii i 


— em mmm mmm ei i i Ce 


FUNCTION Get_Course_To Station(Latitude : Float; 
Longitude : Float) RETURN Integer; 


- = — = Se SS HH we eS SS eee ee ee eee ee ee ae i Oe i le eee 


--| FUNCTION Get_Mine_Hunt_Course 


— me meee wee ww wi ss  S  — 


BUN eCaLON Got Mi new Hunt Coumse (hard biden loat; 
Longitude : Float) RETURN Integer; 


END Expert _Systems_Pkg; 


— — = = ow oe oe oe ws w—w— ww www wee ee ee ie 


--| Filename : Wrap AUV_C_Code_Pkg.ads 


--| Author > LT Wietfranve= Carroll USN 
--| Date : 30 May 2000 
--| Course : Thesis 


--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 
--| Description: Provides for the interfacing to auv_c_functions.c 


— memes eee eee es 


WITH Interfaces; 

USE Interfaces; 

WITH Interfaces.C; 

USE Interfaces.C; 

WITH Interfaces.C.Strings; 
USE Interfaces.C.Strings; 


PACKAGE Wrap AUV_C_Code_PKG IS 


PROCEDURE Text From ¢ Functzon{(A String = {euars per) - 
pragma Export (Convention => C, 
PiGiey —- lextar rom CablincuLon, 
External Name => "CStringBack") ; 


meme meee et ei iii ei ie i ii i 


PROCEDURE End fext From C Functten(A Steing = chauseptn) ; 
pragma Export (Convention => C, 
BneEley —> End Text From Gerhunction, 
External Name => "EndCStringBack") ; 


www meee ei i i ee ss 


meee meee 


PROCEDURE Double From_C_Function(C_Double : C.double) ; 
pragma Export (Convention => C, 
BNtity => Double Prommesruncteion, 
External Name => "CDoubleBack") ; 


— meee ei iii i 


PROCEDURE Stop _Screw_Motors; 


eee eee ee i ee i i eee 


eee meme i i i i ee i 


PROCEDURE Rudder Angle(Angle : double); 


meme meme eee eee eee eee 


ee eT ee ee 


PROCEDURE Planes Angle(BowAngle : double; SternAngle : double) ; 


— meee eee eee ii i 


ewe meee meee eee eee eee 


a ee ee ee ee 


ee ee 


— eee ieee wee i 


PROCEDURE Left Screw Speed Control(n_ com : @doubile); 


— meme meee ee ie i 


meme meee eee ei 


PROCEDURE Right Screw Speed (Control(m com =: Deuble) ; 


END Wrap_AUV_C_Code_PKG; 


en 


--| FileName : Utilities.ads 

--| Author : Michael J. Holden, modified by William D. Carroll 
--| Date : July 1999 - May 2000 

--| Project : Thesis 

--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 


--| Description: Package Specification for Utilities. 


With Ada. TexGutO; 
WITH Ada.Calendar; 


PACKAGE Utilities IS 


— mmm ei ee 


— eee eee 


PROCEDURE Get Curremne fame (dour = OUT integer; 
Minute : OUT Integer; 
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Seconds : OUT Float) ; 


— meme ee 


meee i 


PROCEDURE Communicate (Item: IN String) ; 


—_— — ee ime ie eee ee 


meme iii ie i i 


PROCEDURE Display Message (Message Text : IN String) ; 


meee ee ee 


-- | PROCEDURE Print Symbol 

--| Post: Displays a symbol on the same line a number of times. 
--| Symbol is the character to be repeated 

--| HowMany is the number of times to repeat the character 


PROCEDURE Print Symbol (Symbol : IN Character; 
HowMany : IN Natural) ; 


END Utwilities; 


— eee ei 


--| FileName : OOD Task Manager Pkg.adb 

--| Author : LT wall ikem D.- Carroll “USN 

--| Date ; 09 NOV 1999 - June 2000 

--| Project : Thesis 

--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 


--| Description: This Package receives the direction from the Stratigic 
-- | evel through the Receive Onaers procecdunems (nev code 
--| for the NAV, ENG, & LOG tasks are located here. 


— ewe iii i i 


WITH Ada -TExe uo, 

WITH Ada Integersrext 10; 
WITH Ada.Float Vexerio; 
WITH Utilities; 

WITH Mission_Control_ Pkg; 
WITH Bxpert Systemsmeece, 
WITH Wrap AUV € Code Pkg; 
WITH OOD Pkg; 

use Ada; 


PACKAGE BODY OOD _ Task Manager Pkg IS 


~- Task NAV, ENG, LOG, will start executing as soon as the project 
-- program is started. 

-- Each task will block on its ACCEPT until the entry is called. 
-- The tasks will end when this program is no longer active. 


oe, 


me meee ei i i i i ee sie ee es ee ew Bw wh Bw hl whl OT lhCULUw OT hCUOWCLCU Uw LUc lLULUw hlUwe LULU lee ee 


TASK BODY NAV IS 


NavName : Name String Type := "Navigator "; 
Course : Course String Type := "000"; 
Recomended Course : Integer := 0; 
BEGIN -- NAV 
Uta ti1es Communicate ('Navigacem. l'Standancgen 
Ne 
LOOP 
SELECT 
ACCEPT Taking Action; 
Ucilities .CommuniacatewaNavagator: ""Taking action! ""); 
OR 
ACCEPT Making_Report (Name : IN Name_Type; 


REPGuE ser eDOreccering. pype) DO 
CASE Name IS 
WHEN Navigator => NULL; 
WHEN Engineer => 
Utilities.Communicate ("Navigator makes report to Engineer 
a 
ENG.ENG Aye (Name => NavName, EngOrder => None) ; 


WHEN OfficerO£fTheDeck => 
Utilities.Communicate ("Navigator makes report to OOD 


poe 
OOD Pkg.Roger_Out(Name => NavName) ; 


END CASE; 
END Making_Report; 
OR 
ACCEPT NAV_ Aye (Name 7 IN OUT Name String Type; 
NavOnrder i: Order Type, 
Latitude : Float := 0.0; 
Longitude™; Float == 0.0)2noe 
CASE NavOrder IS 
WHEN None => 
Utilities.Communicate ("NAV: ""Navigator Aye"": Ack. " & 
Name & " Le 
WHEN CourseToStation => 
Utilities.Communicate ("NAV: ""Get Course Aye"": Ack. " & 
Name & " Je 


Recomended_Course := 
Expert_Systems_Pkg.Get Course To Station(Latitude => Latitude, 


Longitude => Longitude) ; 
Course := Integer'Image (Recomended Course) ; 
Utilities.Communicate ("Navigator Recommends Course of " & 
Course” 2: "7 eo OOD is 
OOD_Pkg.Roger Out (Name => NavName) ; 
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WHEN MineHuntCourse => 
Utilities.Communicate ("NAV: ""Mine Hunt Course Aye"": Ack. 


" & Name & " ag Fee 


Recomended_Course := 
Expert Systems Pkg.Get_Mine_Hunt_Course (Latitude => Latitude, 


Longitude => Longitude) ; 
Course := Integer'Image (Recomended Course) ; 
Utilities.Communicate ("Navigator Recomends Course of " & 
Course & " to OOD “ae; 
OOD_Pkg.Roger_ Out (Name => NavName) ; 


WHEN GivePosition => 


Utilities.Communicate ("NAV: ""Give Position Aye"": Ack. " 
& Name & " a) 
Utilities.Communicate ("Current position: 36.70 Deg North 
Latitude ee 
Utilities.Communicate (" 121.85 Deg West 
Longitude Males 
WHEN others => NULL; 
END CASE; 
END NAV Aye; 
OR 
TERMINATE; 
END SELECT; 
END LOOP; 
END NAV; 


TASK BODY ENG IS 


EngName @eName String Typem@= "Engineer" ; 
BEGIN -- ENG 
Utilities.Communicate ("Engineer: ""Standing by"" 
Le 
LOOP 
SELECT 
ACCEPT Taking Action; 
Utilities.Communicate ("Engineer: ""Taking action""") ; 
OR 


ACCEPT Making Report (Name : IN Name_Type) DO 
CASE Name IS 
WHEN Navigator => 
Utilities.Communicate ("Engineer makes report to Navigator 


NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 


WHEN Engineer => NULL; 
WHEN OfficerOfTheDeck => 
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Utilities.Communicate ("Engineer makes report to OOD 


OOD_Pkg.Roger_Out (Name => EngName) ; 
END CASE; 
END Making_Report; 
OR 
ACCEPT ENG Aye(Name : IN OUT Name_String_Type; 
Hagerder -semeerelype) DO 
CASE EngOrder IS 
WHEN None => 


Utilities.Communicate ("ENG: ""Engineer Aye"": Ack. " & 
Name & " a a 
WHEN AllStop => 
Utilities.Communicate ("ENG: ""All Engines Stop Aye"": Ack. 
"-& Name & " ")- 
Wrap _AUV_C_ Code _PKG.Stop_Screw_Motors; 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN AllAhead => 
Utilities.Communicate ("ENG: ""All Engines Ahead Aye"": 
Ack. " & Name & " "); 
Wrap AUY §C Code Pre Hert screw Specd Coptroin(s..0)7 
Wrap AUV_C Code PKG.Right Screw_Speed_ Control (5.0); 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN PortStop => 
Utilities.Communicate ("ENG: ""Port Engine Stop Aye"": Ack. 
Nae Name is ois 
Weap  AUV ee Code PKC Lert Screw speed Control (Oma, 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN PortAhead => 
Utilities.Communicate ("ENG: ""Port Engine Ahead Aye"": 
Ack." & Name ££ " "); 
Wrap AUY GeCode PKG. Leme Screw Speed Control(5.0),; 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN PortBack => 
Utilities.Communicate ("ENG: ""Port Engine Back Aye"": Ack. 
Wt iS, Name cS 1 Le 
Wrap AUV #@u@eode PKG Lett Serew specd Control (Sue); 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN StbadStoepe=— 
Utilities.Communicate ("ENG: ""Starboard Engine Stop Aye"": 
Ack. " & Name & " "); 
Wrap _AUV_C Code PKG.Right Screw_Speed Control (0.0); 
NAV.NAV_Aye(Name => EngName, NavOrder => None) ; 
WHEN StbdAhead => 
Utilities.Communicate ("ENG: ""Starboard Engine Ahead 
Aye"": Ack. " & Name ); 
Wrap AUV_C_Code_PKG.Right Screw Speed Control (5.0); 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN StbdBack => 
Utilities.Communicate ("ENG: ""Starboard Engine Back Aye"": 
Ack. " & Name & " "); 


Wrap AUV_C Code PKG.Right Screw Speed Control(5.0); 
NAV.NAV_Aye(Name => EngName, NavOrder => None) ; 
WHEN EmergencySurface => 


Utilities.Communicate ("ENG: ""Emergency Surface Aye"": 
Ack. " & Name & " "); 
Wrap_AUV_C Code_PKG.Abort_Mission; 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN RudderAmidship => 
Utilities.Communicate ("ENG: ""Rudder Amidship Aye"": Ack. 
" © Name & " dies 
Wrap AUV_C_Code_PKG.Rudder_Angle (0.0); 
NAV.NAV_ Aye (Name => EngName, NavOrder => None) ; 
WHEN RightRudder => 
Utilities.Communicate ("ENG: ""Right Rudder Aye"": Ack. " & 
Name & " i er 
Wrap AUV_C Code _PKG.Rudder Angle(0.4); 
NAV.NAV_ Aye (Name => EngName, NavOrder => None) ; 
WHEN LeftRudder => 
Utilities.Communicate ("ENG: ""Left Rudder Aye"": Ack. " & 
Name & " eee 
Wrap AUV_C Code _ PKG.Rudder Angle (0.4); 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN ZeroPlanes => 
Utilities.Communicate ("ENG: ""Zero Planes Aye"": Ack " & 
Name & " A 
Wrap AUV_C Code vPKG-Planes Angle(0707 0-0) ; 
NAV.NAV_Aye (Name => EngName, NavOrder => None) ; 
WHEN UpPlanes => 


Utilities.Communicate ("ENG: ""Up Planes Aye"": Ack " & 
Name ); 
Wrap _AUV_C_Code_PKG.Planes_Angle(0.4, 0.4); 
NAV.NAV_Aye (Name => EngName, NavOrder => None); 
WHEN DownPlanes => 
Utilities.Communicate ("ENG: ""Down Planes Aye"": Ack. " & 
Name & " ae 
Wrap AUV_C_ Code PKG.Planes Angle(0.4, 0.4); 
NAV.NAV_Aye (Name => EngName, NavOrder => None); 
WHEN others => NULL; 
END CASE; 
END ENG Aye; 
OR 
TERMINATE; 
END SELECT; 
END LOOP; 
END ENG; 


_—— meee eee 


TASK BODY LOG IS 

DeckLogName : Name_String Type := "Deck Log "; 
Deck bog = Ada. Téextmie sa wile wipe, 

FileName : String := "DeckLog.txt"; 

BEGIN -- LOG 


Ada. Texts 10. Create (File =2 "Deck elheg, 
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Modem=> Adam@ext_TOm@utwri le; 
Name => FileName) ; 


Utilities.Display Message (Message Text => "Deck Log is open.") ; 


LOOP 
SELECT 
ACCEPT Log It(Item  : IN String; 
Hews : IN Integer; 
Minute : IN Integer; 
Seconds: IN Float) DO 
Ada. Text, TO 7Put (File =S Deck Ged, 
Item => Item & "At: ~~"); 
Ada.Integer Text_I0.Put(File => Deck_Log,Item => Hour, Width 
=> 2); 
Ada.Text I0.Put(File => Deck_Log,Item => ":"); 
Ada -Integer Text 10 Pur(eere => Deck lLog,1tem, —— Minute, Width 
— 2) 
Ada.Text I0.Put (File => Deck Log,Item => ":"); 
Ada.Float_Text_IO.Put (File => Deck_Log, 
Item => Seconds, Fore => 2, Aft =>10, Exp => 
Oy 
Ada.Text_IO.Put_Line(File => Deck_Log, 
heen => "= '!) - 
END CoOogmic ; 
OR 


ACCEPT Close Log; 
Ada.Text 21O.Close(File =s Deck»Log)¥ 
Utilities.Display Message (Message Text => "Deck Log is 
closed."); 
OR 
TERMINATE; 
END SELECT; 
END LOOP; 
END LOG; 


— mw wwe 
Se ee) 
— eee eee eee eee eee eee eee ie 


_— eee eee eee eee eee eee 


PROCEDURE Mission _ Planner (Orders Orde un type 
Latitude : Float; 
Longitude : Float) IS 


BEGIN 
CASE Orders IS 
WHEN None => 
Utilities.Communicate ("No Mission received"); 
WHEN HuntMines => 
Utilities.Communicate ("Commence Mine Hunt Mission 


ae 
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Mission Control Pkg.Transit_To Location(Latitude, Longitude) ; 
Mission_Control_Pkg.Hunt_For_ Mines; 
WHEN others => NULL; 
END CASE; 


END Mission_Planner; 


— meme 


PROCEDURE Offi1censOr Thespeck (Orders moOLdeT Lype; 
Latitude : Float; 
Longitude : Float) IS 


BEGIN =- Officer Of The Deck 


Utilities.Communicate ("OOD: ""I have the Deck"" 
Ls 


Mission Planner(Orders, Latitude, Longitude) ; 
Utilities.Communicate ("Surface the AUV for recovery 

she fer 
OOD _Pkg.Give Order(Name => Engineer, Order => EmergencySurface) ; 


LOG .Close “bog; 


ENE SOLEtCe EI Ch mer Deck, 


mw i 


— eee eee eee ies eee 


PROCEDURE Receive Orders (Orders ;: Ordermm=ypey 
Latitude : Float; 
Longitude : Float) IS 


BEGIN 
Officer Of The Deck (Ordenage latiatuce, Longitude), 
END Receive Orders; 


END OOD_Task_Manager_ Pkg; 


—— eee ie 


--| FileName : OOD _Pkg.adb 

--| Author * LT William DaeCarroll, Ush 

--| Date : June 2000 

--| Project : Thesis 

--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 


--| Description: OOD Procedures 


WITH Utilities; 
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PACKAGE BODY OOD Pkg IS 


OodName : OOD_Task_ Manager _ Pkg.Name_ String Type := "OOD NS 


PROCEDURE Give _Order (Name : IN OOD_Task_Manager_Pkg.Name_Type; 

@nrder: OOD TaskeyManager Pkg Order Type; 
Latitude : Float := 0.0; 

Longitude : Float := 0.0) IS 

BEGIN 
CASE Name IS 
WHEN OOD_Task_Manager_Pkg.Navigator => 
Utilities.Communicate ("OOD gives order to Navigator 


OOD_Task_Manager_Pkg.NAV.NAV_Aye (Name => OodName, 
Navorder => Order, 
Latitude => Latitude, 
Longitude => Longitude) ; 
WHEN OOD_Task_Manager_Pkg.Engineer => 
Utilities.Communicate ("OOD gives order to Engineer 


oc 
OOD_Task_Manager_Pkg.ENG.ENG Aye(Name => OodName, 
EngOrder => Order); 
WHEN OOD_Task_Manager_Pkg.OfficerOfTheDeck => NULL; 
END CASE; 
END GavevOrder; 


—_— eee 


meme wee we wees 


PROCEDURE Taking Action IS 


BEGIN 
Utilities .Communicate (OOD: "Taking action" 
on, 
DELAY 0.1; -- lets another task have the CPU 


END Taking Action; 


meee ie ie eee a el 


PROCEDURE Roger_Out (Name : IN OUT 
OOD_Task_Manager_Pkg.Name_ String Type) IS 


BEGIN 
Utilities.Communicate ("OOD: ""Roger Out"": Acknowledge " & Name 


& " LA 
END Roger Out; 


END OOD Pkg; 
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mm meee eee eee i ae eee ee ii i i 


--| FileName : Mission_Control_ Pkg.adb 


--| Author TET WidteanwD. Carroll. USN 

--| Date : June 2000 

--| Project : Thesis 

~-| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 


--| Description: This package provides Mission Procedures 
WITH OOD Task Manager Pkg; 

USE OOD_Task_Manager_Pkg; 

WITH OOD Pkg; 

WITH Utilities; 


PACKAGE BODY Mission_Control_Pkg IS 


meme eee eee eee eee ee i 


PROCEDURE Transit To Location(Latitude : Float; 
Longitude : Float) IS 
BEGIN 
Utilities.Communicate ("Commence Transit To Location Mission 
Je 
OOD_Pkg.Give Order (Name => Navigator, Order =="ComrseTostatron, 
Latitude => Latitude, Longitude => Longitude) ; 
OOD_Pkg.Give Order(Name => Engineer, Order => AllAhead) ; 
OOD_Pkg.Give_Order (Name => Engineer, Order => RightRudder) ; 
OOD_Pkg.Give_Order(Name => Engineer, Order => RudderAmidship) ; 
OOD_Pkg.Give_ Order (Name => Engineer, Order => DownPlanes) ; 
OOD Pkg.Give_Order (Name => Engineer, Order => ZeroPlanes) ; 
OOD_Pkg.Give_Order(Name => Navigator, Order => GivePosition) ; 
OOD Pkg.Give Order(Name => Engineer ,#Order => AllStop) ; 
Utilities.Communicate ("Transit To Location Mission Complete 
A) 


END Transit _To_ Location; 


me meme eee eee 


PROCEDURE Hunt_For Mines IS 


BEGIN 
Utilities.Communicate ("Commence Hunt _For Mines Mission 

a 
OOD_Pkg.Give_Order (Name => Navigator, Order => MineHuntCourse) ; 
OOD Pkg.Give Order (Name => Engineer, Order => AllAhead) ; 
OOD Pkg.Give_Order(Name => Engineer, Order => RightRudder) ; 
OOD Pkg.Give Order(Name => Engineer, Order => RudderAmidship) ; 
Utilities.Communicate ("Hunt For Mines Mission Complete 


a he 
END. Hunt For Mines; 
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END Mission _Control_ Pkg; 


—_ om oe eee eee eee eee eee eae i i i se ee 


--| FileName : Expert Systems _Pkg.adb 

--| Author Stew lioam D.earrol ls USN 

--| Date : June 2000 

--| Project : Thesis 

--| Compiler : Aonix ObjectAda ger 2.205 (Proféessronal) 


--| Description: Expert Systems functions 


—s ee ee ee eee eee eee 


— te eee eee ieee 


FUNCTION Get Courses lo Seationmiaricude <; Float; 

Longitude : Float) RETURN Integer IS 
Recomendeemeourse = fnteqera— = 0 - 
BEGIN 


RETURN Recomended Course; 
END Get Course To Station; 


— ee eee eee ee eee ieee eee i i ee 


FUNCTION Cem Vainem@iunemecurse (Latitudes: Pitoac, 

Longteude = Filear) SeRETURN Incegqer rs 
ReEcomencedeCourse wemneecgemn=:= 95; 
BEGIN 


RETURN Recomended Course; 
END Get Mane: Huneweourse, 


END ExXpere Syscems Pa; 


—_— — meee eee eee eee a i SS ee 


--| Filename : Wrap AUV_C_ Code Pkg.adb 


--| Author : LT William D. Carroll, USN 

-~| Date : 30 May 2000 

--{ Course : Thesis 

--| Compiler : Aonix ObjectAda 7.1.2.205 (Professional) 


--| Description: Provides for the interfacing to auv_c_functions.c 


=—=——_— ee eee ieee ii ii 


WITH Adardextero; 

WITH Adawinteger text slg; 
With Ada.F loat Text. 10; 
WITH Utilities; 
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PACKAGE BODY Wrap AUV_C Code Pkg IS 


— meee eee eee eee es i 


--| FUNCTION Value_Without_Exception 

--| Lovelace Ada tutorial - David A. Wheeler 

FUNCTION Value _Without_Exception(S : chars_ptr) RETURN String IS 
pragma Inline(Value_Without_Exception) ; 


-- Translate S from a C-style char* into an Ada String. 
-- this tc er, return ”", ACES =zatse an exception: 
BEGIN 
1 Se Cee THEN RETURN "Null Ptr"; 
ELSE RETURN Value (S); 
END er; 
END Value _Without_Exception; 


— meme eee eee eee 


— eee eee ee wee ii i i i i 


PROCEDURE Text _From_C Function(A String : chars_ptr) IS 


-- Convert the sent C chars ptr to an Ada String value without 
-- Gettiag aneexcepetemerr the returned 3s ager. 


Report : Strimg := Value Without Exception (A Strung): 
BEGIN 
Ada.Text_I0.Put (Item => Report & " "); 


END Text From_C_ Function; 


—_ eee eee ee eee ee ii 


PROCEDURE End Text From_C Function({(A™sering “chars ptr. 
-- Convert the sent C chars ptr to an Ada String value wremout 
getting 


== an €XCepElon elf Ene LTeturned eo aie eea te 
Report : String := Value Without _Exception(A String) ; 


BEGIN 


Ada.Text_I0O.Put_ Line (Report) ; 
END En@@Text Premme s:unceion, 


——— oe ee eee eee eee i ee 


—_— oe eee ewe ei eee eee iii ei 


PROCEDURE Double From_C_Function(C_Double : C.double) IS 


-- Cast to a Ada Float value for manipulation within Ada 
Ada Float : Float := Float(C_ Double); 


BEGIN 
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-- Output to the screen followed by a space 
Ada. Float Text TOsPue (Ada Float 2, 4, 0); 
Ada. Text 1@-Fue(icemn => ' “je 


END Double FromiGerumceion; 


--| PROCEDURE Stop Screw Motors 
--~| The function is called "StopScrewMotors" in C. 
--| The function ™ismeound, in the@ebjectmtile "“auvy ci functions.o" 
procedure StopScrewMotors; 
pragma Import (Convention => C, 
Entity => StopScrewMotors, 
External Name => "StopScrewMotors") ; 
-- Wrapper function 
PROCEDURE Stop Screw_Motors IS 
BEGIN 
StopScrewMotors; 
--Ada.Text_IO.Put_Line(Item => "Inside - Stop Screw_Motors") ; 
END Stop Screw Morors; 


--| PROCEDURE Rudder Angle 
--| The function is called "Rudder" in C. 
--| The function is found in the object file "auv_c_functions.o”" 
procedure Rudder (Angle : C.double) ; 
pragma Import (Convention => C, 
Entity => Rudder, 
External Name => "Rudder") ; 
-- Wrapper function 
PROCEDURE Rudder _Angle(Angle : double) IS 
BEGIN 
Rudder (Angle) ; 
END Rudder _ Angle; 


--| PROCEDURE Planes Angle 
--~| The function is called "Planes" in C. 
==| the function is found iin the obyjceretile “auv ¢ functions. 
procedure Planes (BowAngle : C.double; SternAngle: C.double) ; 
pragma Import (Convention => C, 
Entity => Planes, 
External Name => "Planes") ; 
==" Wrapper function 
PROCEDURE Planes Angle (BowaAngle =edouble,  sternAnglie =~ double) is 
BEGIN 
Planes (BowAngle,SternAngle) ; 
END Planes Angle; 


——_—_— or or cr SS ww i i Ss i eS 


--| PROCEDURE Zero Fins 
--| The function is called "ZeroFins" in C. 
=|) the fUmeeten iseroundain the objece ttle au semmumelions,o” 
procedure ZeroFins; 
pragma Import (Convention => C, 
Entity => ZeroFins, 
External Name => "ZeroFins") ; 
-- Wrapper function 
PROCEDURE Zero_Fins IS 
BEGIN 
ZeroFins; 
END Zero Fins; 


ewe eee ee se 


--| PROCEDURE Abort _Mission 
--| The function is called "AbortMission" in C. 
--| The function is found in the object file "auv_c_functions.o" 
procedure AbortMission; 
pragma Import (Convention => C, 
Entity => AbortMission, 
External Name => "Abort"); 
-- Wrapper function 
PROCEDURE Abort_Mission IS 
BEGIN 
AbortMission; 
--Ada.Text_IO.Put_Line(Item => "Inside - Abort Mission"); 
END Abort_Mission; 


TT ee ee eed 


--| PROCEDURE Left_Screw_Speed_Control 
--| The function is called "LeftScrewSpeedControl" in Cc. 
--| This function is found in the object file "auv_c_functions.o" 
procedure LeftScrewSpeedControl(n_com : C.double); 
pragma Impose (Convention =>) C, 
Entity => LeftScrewSpeedControl, 
EXternal Name w=> "LértserevwspecacConece ly, 
-- Wrapper function 
PROCEDURE Left _Screw_Speed_Control(n_com : double) IS 
BEGIN 
LeftScrewSpeedControl (n_com) ; 
END Left_Screw_Speed Control; 


— wee wee wee eee eee es i 


--| PROCEDURE Right_Screw Speed Control 
--| The function is called "RightScrewSpeedControl" in C. 
--| This function is found in the object file "auv_c_ functions.o" 
procedure RightScrewSpeedControl(n_com : C.double) ; 
pragma Import (Convention => C, 
Entity => RightScrewSpeedControl, 
External Name => "RightScrewSpeedControl") ; 
-- Wrapper function 
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PROCEDURE Right Screw_Speed Control(n_com : double) IS 
BEGIN 


END 


RightScrewSpeedControl (n_com) ; 


END Right Sevrew Speed Control, 


Wrap AUV_C Code Pkg; 


FileName : Utilities.adb 

Author : Michael J. Holden, modified by William D. Carroll 
Date July 1999 - May 2000 

Project : THesis 

Compiler ; Aonix ObjectAda 7.1.2.205 (Professional) 


Description: Package Body for Utilities. 


meme ia 


WITH Ada.Text_IO; 

WITH Ada.Float_Text_I0; 
WITH Ada.Integer_Text_I0; 
WITH Ada.IO Exceptions; 
WITH OOD _Task_Manager_ Pkg; 


PACKAGE BODY Utilities IS 


PROCEDURE Get_Current_Time (Hour moULSiieegear, 


Minute : OUT Integer; 
Seconds : OUT Float) IS 


Now : Ada.Calendar.Time:= Ada.Calendar.Clock; 

-- Hour : Integer; 

-~- Minute : Integer; 

--~ Seconds > Float: 
Second : Ada.Calendar.Day™*™Duration; 
FloatSecond : Float; 
FloatMinute : Float; 
FloatHour : Float; 

BEGIN -- Display _Current_Time 
Second := Ada.Calendar.Seconds (Now) ; 
FloatSecond := Float (Second) ; 
FloatMinute := FloatSecond/60.0; 
FloatHour := FloatMinute/60.0; 
Hour -= Integer (PloatHour — 0.5). 
Minute := Integer( ( ( FloatHour - Float(Hour) ) * 60.0) - 0.5 ); 
Seconds := (FloatSecond-((Float (Minute) * 60.0)+(Float(Hour) * 
3601000) 

Ada. Integer Text TO °Pur (teens == hot, Width => 2); 


Ada.Text_IO.Put (Item => ":"); 

Ada -Integenalext 10 7Pun(lremm--—amure, Width => 2); 

Pada lene fOebut (lEeme=e y=) 

--Ada.Integer Text _I10.Put (Item => Seconds, Width => 2); 
Ada.Float Text _IO.Put(Item => Seconds, Fore => 2, Aft =>4, Exp => 


Ada.Text_IO.New_ Line; 


a2 


END CClme@ummene time; 


ee ee ee ee 


PROCEDURE Communicate (Item: String) IS 


log Strange ot~ing = .— Teen; 
Hour ; Integer; 
Minute : Integer; 
Seconds : Float; 

BEGIN -- Communicate 


Ada.Text_IO.New_Line; 
Ada-Text TO.Put (item => Item & " At: "); 
Gcteecuprente tame (Hour, Mingee,, Seconds): 
Ada.Text_IO.New_Line; 


OOD_Task_Manager_Pkg.LOG.Log It (Item => Log String, 
Houm = Sour: 
Minute => Minute , 


Seconds => Seconds) ; 
END Communicate; 


— mmm meee wee eee i i 


— emi ses ss 


PROCEDURE Display Message (Message Text : IN String) IS 
LineWidth : Natural := 70; 


BEGIN -- Display Message 
Ada . Text 210: Newaibane (Spacing =>2)y; 
Print Symbol (Symbol => '-', 
HowMany => (LineWidth-Message Text'Length)/2 - 1); 


IF Messagestext = "" OR ELSE Message Text jaa” THEN 
Ada.Text_TITO.Put (Item => '-' & '-'); 
ELSE 
Ada.Text_IO.Put (Item => " " & Message Text & " "); 
END IF; 


Prine symbols (| oyibole—= =". 
HowMany => (LineWidth-Message Text'Length)/2 - 1); 
Ada.Text_IO.New_ Line (spacing =>2); 


END Display Message; 


— ii i ie ie ee se 


--| PROCEDURE Print Symbol 

--| Pre : None 

--| Post: Displays a symbol on the same line a number of times. 
--| Exceptions Raised: None. 

--| Parameters: 

--| Symbol is the character to be repeated 
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-- | HowMany is the number of times to repeat the character 
--| Complexity: 0( ) 


—_— — = oe ee ee eee 


—_— eee ei i se lee 


PROCEDURE Print _Symbol (Symbol : IN Character; 


HowMany : IN Natural) IS 


BEGIN -- Print_Symbol 
FOR Count IN 1..HowMany LOOP 
Ada.Text_IO.Put (Item => Symbol) ; 


END LOOP; 


END Print_Symbol; 


END Utilities; 


ah EXECUTION LEVEL CODE 


[| ~------------- 
// FileName 

jj Beehor 

// Date 


// Project 
// Compiler 
//- Beseripticn: 


— ee ee ee eee meee ei 


auv_c_functions.c 

Dr Dave Marco - NPS, modified by William D. Carroll 
May 2000 

Thesis 

GNAT Version 3.12p, used gcc for .o file output 
Modified from "Execf.c" C code written by Dr. D. Marco 
for the Naval Postgraduate School A.R.I.E.S. 
Autonomous Underwater Vehicle (AUV). Changes made by 
LT are denoted by //** in the right margin. Code 

by Dr. Marco that 1s not required for this 
demonstration has been either commented out but 
retained for clarity or has been deleted. 


#inelude <Sedio-h- 
#include <string.h> 


#define LEFT BOW PLANE 
#define RIGHT_BOW_PLANE 
#define LEFT STERN PLANE 
#define RIGHT STERN PLANE 
#define BOW RUDDER 
#define STERN RUDDER 


StopScrewMotors () 


Om fF WN 


mw ee 


ce meem iee ee S 


CStringBack("Screw Motors Stoped"); 1S eke 
EndCStringBack("") ; 1 is 
//RubyDac(0,0.0); /* Left Screw */ 
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//Rubybac(2,0.0)> /* Right Screw */ 
} // end StopScrewMotors () 


ee 
// NAME ScrewMotor 

[ [ == =~ = 2-222 en nnn nnn nnn nnn nnn ene ee ee ee eee ---- 
ScrewMotor (int Motor, double ControlVolt) 

{ 

char* retchar = "No Action ScrewMotor"; 

TE wtloton .—=— 0) { [xe 
CStringBack ("From ScrewMotor: Left Screw at:"); [/** 
CDoubleBack (ControlVolt) ; //** 
EnadG@stringsack ("VDC"); [/[** 

\ //[** 

if (Motor == 1) { //** 
CStringBack ("From ScrewMotor: Right Screw at:"); /[** 
CDoubleBack (ControlVolt) ; [/** 
EndCStrangBack( Vee ye //** 

} 


/* Motor = Motor number, 0 Left Screw Ch = O79" Pin 2 and BO 2 
alk Right Screw Ch <=1, Pine 4.and BO 4 


Volt = Control Voltage Sent to Servo Amplifier +-5 VDC 
ey 


\//end ScrewMotor () 


void ControlSurface(int Surface, double Angle) 


/* This function sends the desired ANGLE (radians) to the specified 
control SURFACE */ 


switch (Surface) 


{ 

case 1: 
CStringBack ("Left Bow Plane set to:"); is 
CDoubleBack (Angle) ; [ere 
EndCStringBack ("radians") ; [ [ee 
// code deleted 
break; 

case 2: 
CStringBack("Right Bow Plane set to:"); es 
CDoubleBack (Angle) ; ee 
EndcCStringBack ("radians") ; (er 
// code deleted 
break; 

case 3: 
CStringBack ("Left Stern Plane set to:"); ia) a 
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CDoubleBack (Angle) ; 
EndCStringBack ("radians") ; 
// code deleted 

break; 


case 4: 
CStringBack("Right Stern Plane set to:"); 
Cbeubleback (Augie): 
EndCStringBack ("radians") ; 
// code deleted 
break; 


case 5: 
CStringBack ("Bow Rudder set to:"); 
CDoubleBack (Angle) ; 
EndcStringBack ("radians") ; 
// code deleted 
break; 


case 6: /* This Uses the Second 9513 Chip */ 
CStringBack("Stern Rudder set to:"); 
CDoubleBack (Angle) ; 
EndCStringBack ("radians") ; 
// code deleted 
break; 


default: 
GSeringBback (“No wActicon to controlSuztace™)- 
EndCcStringBack("") ; 
//orintt (“Invalid sumtace code \n"); 
break; 


} // end ControlSurface() 


Rudder (double Angle) 


/* Send Angular Deflection (RADIANS) to Rudders. 
Convention: (+) Angle Right-Hand Rule about z-axis */ 


ControlSurface (BOW RUDDER, -Angle) ; 
ControlSurface (STERN_RUDDER, Angle) ; 


} /* Rudder */ 


Planes (double BowAngle, double SternAngle) 


/* Send Angular Deflection (RADIANS) to Planes. 
Convention: (+) angle Right-Hand Rule about y-axis */ 
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//[** 
J [=* 


//** 
[/+* 
//** 


//** 
//** 
//** 


//[** 
//** 
[[** 


//** 
//[** 


ControlSurface (LEFT_BOW_PLANE, -BowAng1le) ; 
ControlSurface (RIGHT BOW PLANE, BowAngle) ; 
ControlSurface (LEFT_STERN_PLANE, SternAngle) ; 
ControlSurface (RIGHT _STERN_ PLANE, -SternAngle) ; 


} /* Planes */ 


ZeroFins () 


{ 


CStringBack("Fins at zero"); //** 
EnGGSeringback a ; //** 


Rudder (0.0); 
Planes (0.0,06.0) - 


CStringBack("*** Inside Abort *** EMERGENCY SURFACE! !!!!"); hg 
EndcCStringBack ("") ; ee 
//printf£ ("Inside Abort\n") ; 

Rudder (-0.4); 

Planes (0.4,-0.4); 

ScrewMotor(0,5.0) ; 

ScrewMotor(1,5.0); 


hettScerewspecdeentre!l (deuble nmiucom) 


{ 
double Limit; // parameter required for the algorithm in the 
double e n;v_spc; // original code. 


//code deleted, v_spc is not made equal to n_com in the original 
GOde. 
vV_spc = n_com; 


ScrewMotor (0,v_spc) ; 


Rightscrewspecdeontrolideuple acon) 


double Limit; // parameter required for the algorithm in the 
double e n,v_spc; // original code. 


i) 


//code deleted, v_spc is not made equal to n_com in the original 


code. 
v_spc = n_com; 


ScrewMotor (1,v_spc) ; 
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APPENDIX B. OUTPUT 


OUTPUT 


Navigators "Standingeby" Bi (le Side 2 0 a) 1 
Engineer: "Standing by" At: i! :. 5.1.2 2 Sm 
OOD: "I have the Deck" At: 1: 5 IZ cenee eal 


ssleinaiostasintontodiadinnaettatadatiadnandatatatmatadtes Deck Log 1S open. ------------------------- 


Commence Mine Hunt Mission De le Sa BO 86 o 
Commence Transit_To Location Mission Piette les 1 2B O69 
OOD gives order to Navigator At: 1:51:28.0869 
NAV: "Get Course Aye": Ack. OOD Dec d Sd. 2 6.0069 
Navigator Recommends Course of 90 to OOD Ate. 1275122870869 
OOD: "Roger Out": Acknowledge Navigator Bie eel Sd 2.8097 2 
OOD gives order to Engineer Atty. SL 3S 28 0072 
ENG: "All Engines Ahead Aye": Ack. OOD AG e513: Zeng 72 
From ScrewMotor: Left Screw at: 5. 0000] De 


From ScrewMotor: Right Screw at: 5.0000 VDC 


NAV: "Navigator Aye": Ack. Engineer Aese 1:5isze-0er2 
OOD gives order to Engineer At: VileS1- 2350972 
ENG: "Right Rudder Aye": Ack. OOD At: 1:51:28.0972 


Bow Rudder set to: -0.4000 radians 
Stern Rudder set to: 0.4000 radians 


NAV: "Navigator Aye": Ack. Engineer Ae: ./ 1251228469 
OOD gives order to Engineer Ber ol: Si ve oro 
ENG: "Rudder Amidship Aye": Ack. OOD At: 1:51:28.1069 


Bow Rudder set to: 0.0000 radians 
Stern Rudder set to: 0.0000 radians 


NAV: "Navigator Aye": Ack. Engineer Att d:SisZereae 


OOD gives order to Engineer Atr’ 1 Sl Ziee roars 
De, 


ENG: "Down Planes Aye": Ack. OOD 

Left Bow Plane set to: -0.4000 radians 

Right Bow Plane set to: 0.4000 radians 

Left Stern Plane set to: 0.4000 radians 

Right Stern Plane set to: -0.4000 radians 

NAV: "Navigator Aye": Ack. Engineer 

OOD gives order to Engineer 

ENG: "Zero Planes Aye": Ack OOD 

Left Bow Plane set to: 0.0000 radians 

Right Bow Plane set to: 0.0000 radians 

Left Stern Plane set to: 0.0000 radians 

Right Stern Plane set to: 0.0000 radians 

NAV: "Navigator Aye": Ack. Engineer 

OOD gives order to Navigator 

NAV: "Give Position Aye": Ack. OOD 

Current poSition: 36.70 Deg North Latitude 
121.85 Deg West Longitude 


OOD gives order to Engineer 


ENG: "All Engines Stop Aye": Ack. OOD 
Screw Motors Stoped 


NAV: "Navigator Aye": Ack. Engineer 
Transit_To Location Mission Complete 
Commence Hunt _For Mines Mission 

OOD gives order to Navigator 

NAV: "Mine Hunt Course Aye": Ack. OOD 
Navigator Recomends Course of 95 to OOD 
OOD: "Roger Out": Acknowledge Navigator 

OOD gives order to Engineer 

ENG: "All Engines Ahead Aye": Ack. OOD 

From ScrewMotor: Left Screw at: 5 000 OmvLe 
From ScrewMotor: Right Screw at: 5.0000 VDC 


NAV: "Navigator Aye": Ack. Engineer 


OOD gives order to Engineer 
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ENG: "Right Rudder Aye": Ack. OOD At: 6:19:32.7969 
Bow Rudder set to: -0.4000 radians 
Stern Rudder set to: 0.4000 radians 


NAV: "Navigator Aye": Ack. Engineer AG. 66-09-32 .-8555 
OOD gives order to Engineer AG eee oe ceo 7 
ENG: "Rudder Amidship Aye": Ack. OOD Ati Jo. 19 2327 260 


Bow Rudder set to: 0.0000 radians 
Stern Rudder set to: 0.0000 radians 


NAV: "Navigator Aye": Ack. Engineer At: 6:19:32.9766 
Hunt For Mines Mission Complete AUG -19- 338 0059 
Surface the AUV for recovery At: 6:19:33 .0352 
OOD gives order to Engineer Pte sO: 19733-0664 
ENG: "Emergency Surface Aye": Ack. OOD AG: bo. 19 :3370057 


Bow Rudder set to: 0.4000 radians 

Stern Rudder set to: -0.4000 radians 

Left Bow Plane set to: -0.4000 radians 

Right Bow Plane set to: 0.4000 radians 

Left Stern Plane set to: -0.4000 radians 
Right Stern Plane set to: 0.4000 radians 
From ScrewMotor: Left Screw at: 5.0000 VDC 
From ScrewMotor: Right Screw at: 5.0000 VDC 


NAV: "Navigator Aye": Ack. Engineer At: 6:19-33822559 
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